AD-A282  836 

■11111111 


ROBUST  CONTROL  OF 
UNDERACTUATED  MANIPULATORS: 
ANALYSIS  AND  IMPLEMENTATION 


Marcel  Bergerman  Yangsheng  Xu 
CMU-RI-TR-94-12 

The  Robotics  Institute 
Carnegie  Mellon  University 
Pittsburgh,  Pennsylvania  15213 

May,  1994 


DTIC 

ELECTED" 

AUG  0  1  1994 


©  1994  Carnegie  Mellon  University 


This  docuoi^ii  besn  approved 

for  public  tai«as«  oad  sole;  ita 
dutaibutio&  is  unliaufd 


94-24161 

iniinii 


This  research  is  partially  sponsored  by  the  Brazilian  National  Council  for  Research  and  Development 
(CNPq).  The  views  and  amciusions  contained  in  this  document  are  those  of  the  authors  and  should  not  be 
interpreted  as  representing  the  official  policies  or  endorsements,  either  expressed  or  implied,  of  CNPq  or 
Carnegie  Mellon  University. 


94  7  29  095 


Table  of  Contents 


1  fintroduction  1 

2  Model  Partition  3 

3  Robust  Control  6 

3.1  Variable  Structure  Controller  6 

3.2  VSC  Design  7 

3.3  Robustness  Issues  9 

4  Case  Study  10 

5  Simulation  Results  12 

6  Condusion  16 

7  Acknowledgments  16 

8  References  17 


Accesion  For  ^  | 

NTIS  CRA& 
DTIC  TAB 
Uiiannour.ccd 
Justification 

n 

□ 

Dis^/ibution  f 

Availability  Codes 

Dist 

^-1 

Avail  c 
Spe 

ind  /  or 
cial 

List  of  Figures 


Hgure  1  Three-link  manipulator  with  one  passive  joint . 19 

Figure  2  Two-link  manipulator  with  one  passive  joint . 19 

Figures  Detmminantof  for  the  2-link  manipulator. . 19 

Hgure4  Determinant  of  for  the  3-link  manipulator. . 20 

Hgure  5  Response  of  the  2-link  manipulator.  Expmimmit  #1 . 20 

Figure  6  Response  of  the  2-link  manipulator.  Experiment  #2 . 20 

Hgure  7  Animation  of  the  2-link  manipulator.  Experiment  #2 . 21 

HgureS  Response  of  the  2-link  manipulator.  Experiment  #3 . 21 

Hgure  9  Response  of  the  3-link  manipulator.  Experiment  #4. . 21 

Hgure  10  Animation  of  the  3-link  manipulator.  Experiment  #5 . 22 

Hgure  1 1  Response  of  the  2-link  manipulator.  Experiment  #1  with 

control  law  from  [1] . 22 

Hgure  12  Response  of  the  2-link  manipulator.  Experiment  #2  with 

control  law  from  [1] . 22 


vii 


List  of  Tables 

Table  1  Numerical  values  of  the  dynamic  parameters . 12 

Table  2  Summary  of  experiments  performed. . 14 

Tables  Summary  of  results  obtaiiwd. . 14 


ix 


Abstract 

Undeiactuated  manipulators  are  robot  manipulators  composed  of  both  active  and  passive 
joints.  Tbe  advantages  of  using  such  systems  reside  in  the  fact  that  they  weight  less  and  con¬ 
sume  less  eneigy  than  their  fully-actuated  counterparts,  thus  being  useful  for  implications 
such  as  space  robotics.  Another  interest  reside  in  the  reliability  or  fault-tolerant  design  of 
fully-actuated  manipulators.  If  any  of  the  joint  actuators  of  such  a  device  fails,  an  entire 
operation  may  have  to  be  aborted  because  of  the  loss  of  one  or  more  degrees  of  freedom. 
The  methodology  proposed  in  this  pim^  uses  the  dynamic  coupling  between  the  passive 
joints  and  the  active  joints,  and  controls  the  active  ones  in  order  to  bring  the  passive  joint 
angles  to  a  desired  set-point  Therefore,  the  control  law  and  the  performance  of  the  system 
are  completely  dependent  on  the  dynamic  model  Since  it  is  difficult  to  obtain  the  exact 
dynamic  model  of  the  system  in  general,  considerable  position  errors  and  even  instability 
can  result  in  some  cases.  In  this  paper,  we  propose  a  variable  structure  controller  to  provide 
the  system  with  the  robusmess  necessary  to  perform  tasks  regardless  of  the  modelling 
errors.  Case  studies  are  provided  as  a  mean  of  illustration. 
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1  Introduction 

In  this  woik,  die  authors  deal  with  die  problem  of  robust  position  control  of  underactuated 
manipulators.  Ifere,  the  word  underactuated  refers  to  the  fact  that  the  manipulator  has  less 
actuators  than  joints.  The  advantages  of  using  such  systems  reside  in  the  fact  that  they  weight 
less  and  consume  less  energy  than  their  fully-actuated  counterparts,  thus  being  useful  for 
applications  such  as  space  robodcs.  For  hyper-redundant  robots,  such  as  snake-like  robots  or 
multilegged  mobile  robots,  where  large  redundancy  is  available  for  dexterity  and  specific  task 
completion,  underactuation  allows  a  more  compact  design  and  simpler  control  and 
communication  schemes.  Another  interest  reside  in  the  reliability  or  fault-tolerant  design  of 
fully-actuated  manipulators  working  in  hazardous  areas  or  with  dangerous  materials.  If  any 
of  the  joint  actuators  of  such  a  device  fails,  one  degree  of  fireedom  of  the  system  is  lost  It  is 
usual  in  this  situation  to  simply  brake  the  failed  joint  and  try  to  resume  the  task  with  less 
degrees  of  freedom  available  [8].  Following  the  methodology  proposed  in  this  work,  the 
passive  (failed)  joint  can  still  be  controlled  via  the  dynamic  coupling  with  the  active  joints, 
and  so  the  system  can  still  make  use  of  all  of  its  degrees  of  fireedom  originally  plaimed.  For 
example,  in  the  extreme  case  of  a  two  DOF  manipulator  performing  pick-and-place 
operations,  the  loss  of  one  DOF  would  be  fatal  for  the  planned  task.  The  results  in  section  5, 
however,  show  that  it  is  possible  to  control  the  failed  joint  and  continue  with  the  task 
successfully. 

Not  until  recently  researchers  started  to  woii^  with  the  control  problem  of  underactuated 
manipulators.  In  [1],  Arai  and  Tachi  proved  that,  at  least  in  a  local  sense,  the  number  of  active 
joints  must  be  equal  or  greater  than  the  number  of  passive  ones  in  order  to  be  possible  to 
control  the  passive  ones.  They  also  developed  a  controller  which  is  very  similar  to  the 
classical  computed  torque  controller,  to  bring  all  joints  to  their  desired  set-points.  The 
drawback  existent  in  this  approach  is  that  a  very  accurate  model  of  the  manipulator  must  be 
provided  to  the  controller.  The  approach  by  Papadopoulos  and  Dubow^  [12],  considered 
the  failure  recovery  control  of  a  space  robotic  manipulator.  In  this  work  also  the  authors  used 
a  computed  torque  controller,  which  requires  an  accurate  model  of  the  systenu  Oriolo  and 
Nakamura  [11]  showed  that  there  does  not  exist  any  smooth  control  law  that  guarantees  that 
the  system  will  stabilize  at  an  equilibrium  point  Therefore,  one  must  either  give  up 
smoothness  in  the  control  law,  or  be  satisfied  with  stabilization  to  equilibrium  manifolds. 
They  showed  that  a  simple  PD  controller  is  able  to  bring  the  system  to  a  stable  configuration 
over  an  equilibrium  manifold.  They  also  present  a  detailed  consideration  about  the  conditions 
for  integrability  of  the  nonholonomic  constraint  present  in  underactuated  manipulators. 
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Finally,  Jain  and  Rodriguez  [7]  jffovided  an  analysis  of  die  kinematic  and  dynamic  issms  of 
this  kind  of  robotic  systmn,  using  the  qiadal  operator  algebra.  Control  issues  were  not  taken 
into  account  in  this  work. 

Hereafter,  we  will  refer  to  active  joints  as  the  ones  which  are  fully-controlled  via  an 
actuator.  Analogously,  passive  Joints  are  those  liriio  cannot  be  controlled  directly,  but  which 
are  equipped  widi  a  brake.  It  is  assumed  that  all  joints,  passive  and  active,  have  position 
encoders  that  provide  a  complete  knowledge  of  the  joint  angles  at  every  sampling  instant  We 
will  denote  by  n  the  total  number  of  joints,  and  by  r  the  number  of  actuators.  The  number  of 
passive  joints  is  thus  p  =  n  -  r.  Following  [1],  our  method  requires  diat  at  least  half  of  the 
joints  be  actuated.  Also  following  the  assumptions  in  [1],  [12],  we  assume  that  there  is 
enough  dynamic  coupling  between  the  passive  and  the  active  joints,  for  it  is  clear  that  if  this 
coupling  is  too  small  (or  does  not  exist  at  all),  it  will  be  impossible  to  change  the  position  of 
the  passive  joints  by  simply  moving  the  active  oires.  Consider  for  example  a  Cartesian  3-link 
manipulator.  Theoretically,  there  is  no  coupling  at  all  between  the  links,  and  a  passive  joint 
could  never  be  controlled  using  the  active  ones. 

The  control  methodology  proposed  in  this  paper  uses  the  dynamic  coupling  between  the 
passive  joints  and  the  active  joints,  and  controls  the  active  ones  in  order  to  bring  the  passive 
joint  angles  to  a  desired  set-point  After  the  passive  joints  reach  the  set-point,  they  are  braked, 
and  the  active  ones  can  be  controlled  to  their  desired  position  via  any  of  a  series  of  controllers 
fully  developed  in  the  literature  for  mechanical  manipulators.  Because  the  control  of  such  a 
system  is  fully  dependent  on  its  dyiuunic  model,  modelling  must  be  accurate.  The  fact  that 
the  performance  depends  on  accurate  modelling  can  be  understood  in  terms  of  the  following 
rationale:  first,  the  control  scheme  depends  on  modelling  accuracy,  and  thus  modelling  errors 
can  result  in  tracking  errors  and  instability.  Second,  the  coupling  between  the  active  and  the 
passive  joints  depends  on  the  dynamic  parameters,  and  is  subject  to  errors  if  tiiere  are 
uncertainties  on  the  values  of  these  parameters.  Third,  one  usually  specifies  the  desired 
motion  of  the  end-effector  in  Cartesian  ^ace,  and  maps  this  motion  to  joint  space,  where 
control  is  executed.  This  mapping  now  is  related  to  the  dynamic  parameters,  and  becomes 
uncertain  if  some  parameters  are  unknown.  Last,  for  conventional  robots  a  local  PID  scheme 
without  a  model-based  feedforward  controller  may  provide  good  trajectory  tracking  results. 
For  underactuated  manipulators,  however,  it  is  impossible  to  control  the  system  with  simple 
PID  schemes,  because  of  the  coupling  between  the  joints. 

Because  modelling  error  is  so  critical  to  the  system’s  performance,  and  because  there  has 
not  been  much  work  addressing  this  issue,  we  present  a  variable  structure  controller  in  order 
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to  provide  the  system  with  the  robustness  necessary  to  perform  tasks  regardless  of  the 
modelling  errors. 

We  address  the  computational  procedures,  simulation  results  and  implementation  issues 
of  the  proposed  scheme.  In  comparison  to  other  approaches,  this  work  demonstrates 
robustness  to  dynamic  parameters  uncertainty  and  efficiency  in  implementation. 

2  Model  Partition 

The  dynamic  modelling  of  underactuated  manipulators  differs  little  from  the  modelling 
of  fully-actuated  ones,  the  only  difference  being  that  the  torque  applied  at  the  passive  joints 
is  constant  and  equal  to  zero.  By  using  either  the  Newton-Euler  method  or  the  Lagrangian 
formulation  [4],  one  can  easily  obtain  the  following  dynamic  description  of  an  open-chain 
mechanical  manipulator,  whose  links  are  considered  as  rigid  bodies: 

X  -  M(q)  'q+b(q,q)  (1) 

In  (1),  Af(q)  is  the  n  X  n  inertia  tensor  matrix  of  the  manipulator,  and  b{q,q)  is  the  n  x  1 
vector  representing  Coriolis,  centrifugal  and  gravitational  torques.  The  vector  x  represents 
the  torques  iq)plied  at  the  active  joints,  and  it  is  a  n  x  1  vector  with  p  components  equal  to 
zero. 


One  of  the  important  issues  when  dealing  with  underactuated  manipulators  is  to  correctly 
perform  a  partition  of  the  dynamic  equation  (1).  Such  a  partition  is  important  to  show  the 
coupling  between  the  passive  and  the  active  joints,  and  it  is  given  as  follows: 


aa  <ip\ 

\^pa  ^pa 


r  P 


(2) 


The  submatrices  of  Af  in  (2)  receive  their  indexes  according  to  the  variables  they  relate.  For 
example,  relates  the  (null)  torques  at  die  passive  joints  to  the  acceleration  of  the  active 

ones.  The  same  reasoning  holds  for  the  other  three  submatrices.  This  partition  is  very  useful 
to  understand  the  dynamic  coupling  between  the  passive  and  active  joints  of  an  underactuated 
manqiulator.  Namely,  from  the  second  lice  of  (2),  we  can  find  out  the  relationship  between 

4a  4p  '‘ 
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Since  this  type  of  manipulator  can  only  produce  torque  at  the  active  joints,  and  thus 
control  Qg  directly,  equation  (3)  shows  that  we  can  control  9^  indirectly,  as  long  as  the 

submatrices  Ai^g  and  Mpp  have  a  structure  that  “allows”  torque  to  be  transmitted  in  a  desired 

way  from  the  active  to  the  passive  joints.  In  this  work,  we  will  assume  that  this  transmission 
is  always  possible,  i.e.,  that  there  is  enough  dynamic  coupling  to  drive  the  passive  joints. 
Current  work  is  being  done  on  the  characterization  of  this  transmission,  with  a  possible 
extension  to  optimal  actuator  placement 

As  was  demonstrated  in  [1],  the  number  of  joints  tiiat  can  be  controlled  at  any  moment  is 
equal  to  the  number  of  active  joints.  Thus,  at  the  beginning  of  the  operation,  we  can  control 
all  p  passive  joints  (via  dynamic  coupling)  and  r-p  active  ones.  These  r  joints  to  be 
controlled  are  then  grouped  in  the  vector  When  r  p,  this  vector  contains  only  passive 
joints.  For  example,  for  the  3-link  manipulator  shown  in  figure  1,  with  joints  1  and  2  active 
and  joint  3  passive,  9^  is  a  two-dimensional  vector  containing  the  passive  joint  and  one 

active  joint  At  this  point  one  could  choose  either  q-^  or  ^2  ^  active  joint  to  be  controlled 
first  Since  the  joints  can  be  arranged  arbitrarily  in  q^,  we  end  up  with  four  possible 
combinations  for  this  rather  simple  manipulator.  We  opted  here  to  stack  the  passive  joints  at 
the  end  of  the  vector  and  to  choose  the  active  joints  closer  to  the  base  to  be  controlled 

first  This  choice  is  based  on  the  fact  that  in  general,  the  joints  closer  to  the  base  are  larger 
and  more  massive,  and  thus  slower.  If  they  are  controlled  to  their  set-points  from  the 
begiiming  of  the  operation,  and  not  only  after  the  brakes  are  applied,  one  can  expect  reduced 
settling  times.  With  the  above  rationale,  the  choice  of  q^  for  the  manipulator  in  figure  1  is: 

Qc  =  [«!  93]  (4) 

Since  we  can  control  r  joints  at  a  time,  the  partitioned  equations  represented  by  (2)  are 
not  very  useful,  since  they  do  not  show  explicitly  which  joints  are  grouped  into  q^.  To  this 
end,  we  consider  a  second  possible  partition  of  (1),  to  be  used  in  the  control  algorithm: 


r 

Mad 

M„' 

ac 

'9d 

P 

^Pd 

pcj 

h 

p  r 


(5) 


s 


Naturally,  the  vector  q^,  where  the  index  d  stands  for  “driving  joints”,  as  opposed  to  c, 
which  stands  for  "controlted  joints,  contains  p  active  joints  to  be  controlled  after  the  joint 
angles  of  the  joints  reach  their  set-point 

It  is  necessary  to  come  up  with  a  systematic  way  to  choose  q^  and  q^  for  a  generic  n-link 

manipulator  with  r  actuators.  We  propose  here  a  set  of  four  matrices  that  perform  this 
selection,  based  on  the  rationale  given  before.  Consider  a  general  n-link  manipulator  with 

joints  numbered  1,  ...,n  from  base  to  the  tip,  and  form  the  matrices  il/j€ 
ilfj  €  91^  ",  €  91"  ^2  €  91"  ^  according  to  the  following  algoriduns: 


i  =  l;j=n; 
while  i  ^  r  do 

if  joint  j  is  active  then 

=  l;i=i  +  l; 

i  =  l;j  =  n; 
while  i  ^  p  do 

if  joint  j  is  passive  then 

i  =  l;j=n; 
while  i  ^  p  do 

if  joint  j  is  active  then 

=  i;i  =  i  +  i; 

i  =  l;j=n; 
while  i  ^  p  do 

if  joint  j  is  passive  then 

=  I;i  =  i  +  1; 

i  =  l;j  =  l; 
while  i  ^  (r  -  p)  do 

if  joint  j  is  active 

=  l;i  =  i  +  l; 

1=1-1; 
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Note  that  the  matrices  thus  formed  consist  only  of  zeros  and  ones,  and  that  their  dimensions 
depend  only  on  n  and  r.  The  desired  partition  is  given  by: 

bg  =  Afjh  bp  =  M2b 

=  9c 

In  section  4  two  examples  that  make  use  of  these  matrices  will  be  presented,  specifically 
for  2-  and  3-link  manipulators. 


Hp^  = 

(6) 


3  Robust  Control 

3.1  Variable  Structure  Controller 

In  this  section  we  develop  a  variable  structure  controller  (VSC)  that  will  guarantee 
convergence  of  the  joint  angles  to  a  desired  position,  despite  possible  modelling  errors. 

The  idea  behind  the  VSC  is  to  force  the  system’s  state  trajectory  to  converge  to  a  pre¬ 
defined  surface  in  the  state  space.  Once  the  system  reaches  this  surface,  it  will  “slide”  along 
it  to  the  origin;  this  is  the  reason  for  this  surface  being  called  sliding  surface  [5].  Once  the 
system  is  sliding  over  this  surface,  its  dynamics  are  described  by  the  equation  of  the  surface 
and  not  by  its  original  ones.  Thus,  modelling  errors  do  not  affect  the  system’s  performance 
after  the  sliding  begins.  Naturally,  two  aspects  are  important  in  this  class  of  controllers:  first, 
the  sliding  surface  must  be  designed  accordingly  to  the  desired  system’s  performance  once 
the  sliding  takes  place.  Linear  surfaces  are  the  most  common,  given  their  design  simplicity. 
For  example,  a  linear  sliding  surface  for  a  second  order  system  could  be: 

s  -  ce  +  e  (7) 

where  e  would  be  the  error  between  the  desired  and  the  actual  state,  and  c  a  (generally 
diagonal)  gain  matrix. 

Second,  a  control  law  must  guarantee  that  the  sliding  surface  is  reachable,  and  that  the 
time  it  takes  for  the  state  trajectory  to  reach  it  is  finite.  This  second  requirement  is  guaranteed 
in  a  region  “close”  to  the  sliding  surface  if,  in  this  region. 
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si<0  (8) 

where  s(x)  s  0  is  the  description  of  the  sliding  surface  s  as  a  function  of  the  state  x. 

32  VSC  Design 

Variable  structure  controllers  have  been  applied  to  standard  manipulators,  and  very  good 
results  have  been  obtained  regarding  trajectory  tracking  and  disturbance  rejection  (see,  for 
example,  [2],  [3],  [S],  [9]).  Here,  we  propose  a  VSC  for  the  underactuated  case. 

Differently  from  fully-actuated  manipulators,  underactuated  ones  cannot  have  all  their 
joint  accelerations  controlled  at  every  time  step.  Since  they  have  only  r  actuators,  it  is 
possible  to  control  r  accelerations  at  a  time  [1].  The  other  p  accelerations  will  depend  on  the 
r  controlled  ones.  To  see  this,  from  the  second  line  of  (5)  we  have: 

■qj  =  (9) 

Thus,  if  we  try  to  control  then  is  fixed  and  cannot  be  arbitrarily  chosen.  Only  after  the 
brakes  are  engaged  can  the  driving  joints’  accelerations  be  controlled. 

Define  the  following  r-dimensional  sliding  surface: 

+  (10) 

where  X  -  xj-x  is  the  error  on  variable  x,  and  is  an  r  x  r  matrix  containing  the  time- 
constants  of  each  surface.  If  the  VSC  can  make  to  be  equal  to  the  following  computed 
acceleration: 


9c  =  Cc9c  +  9c,d+ Vg"(^c) 

where  is  an  r  X  r  matrix,  then  the  time  derivative  of  will  become: 


(11) 


+  '4c,d-^c  =  (^c)  (12) 

Equation  (12)  then  guarantees  that  (8)  is  satisfied  for  s^,  if  one  chooses  appropriate  values 
for  the  entries  of  and  this  in  turn  guarantees  that  the  joint  errors  will  converge  to  zero 
exponentially,  the  convergence  rate  being  determined  by  the  elements  of  c^.  Finally,  in  order 
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to  obtain  the  computed  acceleration  9^ ,  we  compute  ’q^  in  (9)  using  instead  of  9^,  and 
then  substitute  the  obtained  value  of  9^  in  the  first  line  of  (2): 

The  torque  given  by  (13)  guarantees  that  9^  =  9^,  therefore  the  joints  grouped  in  9^  will 

converge  to  their  desired  positions.  At  this  point,  one  has  several  options  for  the  braking 
sequence  of  the  passive  joints  and  controlling  of  the  system,  namely: 

•  brake  each  passive  joint  as  soon  as  they  reach  their  set-points  with  zero  velocity;  wait 
until  all  passive  joints  are  braked  and  the  r  -  p  active  joints  in  9^  also  reach  their  set-point; 

control  the  remaining  joints  in  9^; 

•  brake  each  passive  joint  as  soon  as  they  reach  their  set-points  with  zero  velocity;  wait 
until  all  passive  joints  are  braked;  switch  to  a  new  control  law  in  order  to  bring  all  active 
joints  to  their  desired  set-points; 

•  brake  each  passive  joint  as  soon  as  they  reach  their  set-points  with  zero  velocity;  after 
every  passive  joint  is  braked,  switch  to  a  new  control  law  that  includes  one  more  active  joint 
into  9^  in  substitution  for  the  braked  joint 

The  first  formulation  provides  the  slowest  response,  while  the  third  is  the  most  complicate 
to  implement  It  is  natural,  thus,  to  choose  the  second  one,  which  is  faster  than  the  first  and 
simpler  than  the  third.  In  order  to  implement  the  second  methodology,  we  first  note  that  after 
all  passive  joints  are  braked,  the  new  dynamic  equation  of  the  system  is  simply: 

where  now  and  9^  can  be  obtained  as: 

=  Jl/,9  (15) 

Following  the  same  reasoning  as  above,  let’s  define: 


^a  =  <^a9a  +  9a 


(16) 
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where  Cg  is  an  r  X  r  matrix.  If  we  can  matre  the  acceleration  of  the  active  joints,  ’4^,  to  be 
equal  to  the  following  computed  acceleration: 

+  «a.  d + (1“^) 

where  Pg  is  an  r  X  r  matrix,  then: 

4  *  +  ‘4a.d-9a=‘  “^0*8“  (^a)  (18) 

Using  in  (14)  instead  of  will  then  guarantee  that  (18)  is  satisfied.  The  design  is 
complete  and  all  joints  are  guaranteed  to  converge  to  their  desired  position  after  a  finite  time. 

It  should  be  mentioned  here  that  the  control  laws  (13)  and  (14)  introduce  an  undesired 
chattering  into  the  system,  because  of  the  sgn(.)  functions  in  (1 1)  and  (17).  This  problem  can 
be  solved  with  the  addition  of  a  boundary  layer  around  the  sliding  surface.  For  this  sake,  we 
substitute  the  function  sgn(.)  for  the  following  one: 


sgn  (x)  -4 


sgn(x)  if 

f  if  x<t 
t 


(19) 


In  this  expression,  e  is  the  ‘Ihickness”  of  the  boundary  layer,  pre-defined  by  die  user. 


33  Robustness  Issues 

The  control  methodology  presented  above  provides  the  system  with  a  great  deal  of 
robustness,  because  the  system  is  forced  to  slitte  along  the  sliding  surface.  Therefore, 
modelling  errors  will  not  deteriorate  the  performance  once  die  sliding  begins.  However,  the 
methodology  makes  full  use  of  the  system  model  in  order  to  guarantee  that  the  sliding  occurs. 
Consequendy,  modelling  errors  may  affect  the  performance  by  inhibiting  the  state 
trajectories  to  reach  the  sliding  surface. 

To  overcome  this  problem,  we  considra^  a  very  simple  model  of  the  manipulator  for 
control  purposes,  which  takes  into  account  only  the  inertia  matrix  [3],  [9]: 


Xit)  =  Af(qyq+fit) 


(20) 
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The  quantity  represents  die  uncertainty  and  modelling  errors  in  the  dynamic  model.  This 
“disturbance”yrr>  can  be  estimated  via: 

fit)  =  x(f-Ar)  -MIq(r)]9(t)  (21) 

The  value  obtained  above  may  be  low-pass  filtered  in  order  to  eliminate  high-frequency 
components  derived  firom  numerical  differentiation. 

If  (20)  is  to  be  used  instead  of  (1)  for  control  purposes,  then  one  should  substitute  every 
occurrence  of  b  (q,  4)  in  the  control  algorithm  for  fit).  If  the  system  stabilizes  with  the  use 
of  this  new  control  law,  then  we  can  affirm  that  robustness  to  parameter  uncertainty  was 
obtained. 


4  Case  Study 


Before  presenting  the  results  of  the  simulations,  we  will  present  here  the  partitioning  of 
two-  and  three-link  manipulators.  These  results  will  be  used  in  the  next  section. 

Figures  1  and  2  present  the  manipulators  to  be  used  in  the  simulations.  Considering  first 
the  2-link  manipulator,  the  desired  matrices  are: 


Afj  =  M|'=[oi] 

which  lead  to  the  following  partitioning: 


(22) 


W«f=[l0] 


^pd  =  [o  l] 


1^11  ^1^ 

T 

1^21  ^2^ 

0 

p*^ll  ^1^ 

0 

L"21  "22J 

1 

ki  W12I 

T 

K  "22J 

0 

ki  "12I 

0 

ki  ^^22! 

1 

11 


'12 


=  M. 
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(23a) 

(23b) 

(23c) 

(23d) 
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As  for  the  3-link  manipulator,  with  actiiators  at  joints  1  and  2,  we  get: 


*<r=  [o  I  ^.**2”  [j 


=  [o  0  l] 


W|1  A#|2  Af|3 
^21  ^22  ^23 
^^31  ^^32  ^^33 


^ pc  =[001] 


Mji  M^2  Wi3] 
Af2i  ^22  ^23 
^31  ^32  ^33 


r  1 
00®  1^31  ^33] 


(23e) 

(23f) 

(24) 

(25a) 

(25b) 

(25c) 

(25d) 

(25e) 

(250 
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5  Simulation  Results 

For  simuli^on  purposes,  the  following  values  weie  adopted  for  the  dynamic  parameters 
of  the  manipulators. 


Table  1 :  Numerical  values  of  the  dynamic  parameters. 


PARAMETER 

2-LINK 

3-LINK 

Wi  (Kg) 

2.0 

2.0 

ifij  (Kg) 

1.0 

1.0 

«3  (Kg) 

— 

1.0 

/,(Kgiil*) 

0.2 

0.2 

/j  (Kg  m^) 

0.1 

0.1 

/sOCgm^) 

— 

0.1 

/l(m) 

0.3 

0.3 

/2(m) 

0.3 

0.3 

/a  (m) 

— 

0.3 

‘c,  (■”) 

0.15 

0.15 

(">) 

0.15 

0.15 

— 

0.15 

Using  these  values  and  the  partitions  presented  on  section  4,  we  can  easily  perform  a  pre¬ 
analysis  of  the  dynamical  singularities  of  both  manipulators.  The  idea  is  to  compute  die 
determinant  of  the  matrix  and  check  to  see  if  it  is  below  some  specified  threshold  over 

all  possible  values  of  q.  In  our  case,  the  sub-matrix  Mpj  for  the  2-link  manipulator  is  a 
function  of  62,  and  for  the  3-link  one,  a  function  of  6^.  Hgures  3  and  4  show  the  value  of 
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del  (Mpj)  over  the  entiie  possible  range  of  the  n^tioned  angles.  As  we  can  see,  there  are 
no  dynamical  singular  points  in  bodi  cases,  Le., 

det(Mp^)#0,Vg€91«  (26) 

In  othm:  words,  we  can  make  die  manipulator  go  from  any  initial  to  any  final  position  without 
concerning  with  die  inversion  of  the  sub-matrix 

In  the  cases  where  these  dynamic  singularities  may  occur,  the  performance  of  the  system 
is  compromised.  One  solution  that  the  authors  are  investigating  is  the  use  of  redundant 
control  techniques,  in  onter  to  drive  a  redundant  underactuated  manipulator  away  from 
dynamically  singular  points.  The  redundancy  could  frirth^  be  used  to  minimize/maximize  a 
performance  criterion,  such  as  manipulability  or  energy  consumption,  and  to  account  for 
obstacle  avoidance. 

In  order  to  demonstrate  the  robustness  of  the  proposed  controller,  we  are  going  to  present 
here  experiments  using  the  fuU  dynamic  model  in  (13)  and  (14),  and  then  foUowing  the 
methodology  presented  in  section  3.3. 

The  objective  of  the  simulations  presented  here  was  to  make  the  manipulator  achieve  a 
final  desired  position,  i.e.,  we  were  interested  in  the  step  response  of  the  joint  angles.  We 
chose  to  brake  the  passive  joints  whenever  ttey  reached  a  joint  angle  error  of  less  than  0.0015 
rd  (approximately  0.08  degrees),  with  a  joint  velocity  of  less  than  0.001  rd/s.  This  rasured 
that  the  passive  joints  were  braked  at  a  point  whoe  they  were  practically  at  rest  and  with 
negligible  steady-state  error. 

Table  2  summarizes  the  set  of  experimrats,  along  with  the  gains  used  at  each  one.  Ihble 
3  presents  the  results  obtained  for  each  experiment,  and  also  refers  the  reader  to  the 
appropriate  figures  illustrating  the  results.  All  angles  are  in  (tegrees. 

The  first  experiment  consisted  of  driving  the  joints  over  a  90  degree  excursion.  Note  in 
figure  S  that  the  active  joint  initially  moves  towards  negative  angles  in  order  to  bring  the 
passive  joint  to  its  desired  set-point  with  zero  velocity.  Hiis  is  achieved  at  t  =  0.7392  s,  when 
the  brake  is  engaged.  From  this  point  on,  the  active  joint  is  self-controlled  and  reaches  its  set- 
point  with  zero  velocity  after  a  total  of  3.6804  s.  In  this  first  experiment  the  full  dynamic 
model  was  used. 
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Table  2:  Summary  of  experknents  performed. 


Bl 

Robot 

Full 

model 

1 

2-link 

yes 

10.0 

4.1 

200.0 

200.0 

0.03 

0.06 

2 

2-link 

no 

10.0 

4.1 

200.0 

200.0 

0.03 

0.06 

3 

2-link 

no 

10.0 

4.1 

200.0 

200.0 

0.03 

0.06 

4 

3-link 

no 

hi 

[3.7  Ol 

'o  0’ 

,si, 

[100  IQOI 

0.03 

0.06 

LoioJ 

Lo  3.7J 

Lo  ioo{ 

Table  3:  Summary  of  results  obtained. 


Initial 

angle 

Final 

angle 

desired 

Hnal 

angle 

error 

Brake 
applied  at 
(s) 

Hguie 

1 

1 

1 

1 

1 

1 

1 

^.ooof 

.0.0856. 

0.7392 

5 

2 

1 

9 

1 

1 

1 

^.oooi 

.0.0856. 

0.7122 

6,7 

3 

1 

1 

1 

’90' 

r7C 

b.0804| 

.0.077^ 

0.8610 

8 

4 

1 

E 

0.7926 

9,10 

In  order  to  test  the  robustness  of  the  VSC,  the  same  experiment  was  performed  following 
sectimi  3.3,  i.e.,  only  the  inertia  matrix  was  considered  for  control  purposes.  Comparing  the 
first  and  second  lines  of  table  3,  and  figures  5  and  6,  we  can  affirm  that  robustness  to 
uncertainties  (in  this  case,  modelling  errors)  is  guaranteed.  For  this  expeiimmit,  figure  7 
shows  the  2D  animation  of  the  links  of  the  manipulaton  From  this  figure,  one  can  understand 
how  the  dynamic  coupling  is  used  by  die  active  joint  to  control  the  passive  one.  Namely,  the 
active  moves  down  until  the  passive  reaches  its  set-poinL  Then  the  brake  is  engaged  and  the 
active  joint  can  move  up  to  teach  its  own  set-point 
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Experiment  #3  consisted  of  controlling  the  passive  joint  in  a  legicm  of  great  instability  for 
the  active  joint,  around  6|  s  %/2.  Note  in  figure  8  how  die  active  joint  move  to  accomplish 

the  proposed  objective.  In  this  experiment  also  the  reduced  dynamic  model  was  used, 
illustrating  once  more  the  robustness  of  the  VSC. 

Finally,  experiment  #4  was  peiformed  with  the  3-link  manqiulator.  Note  in  figure  9  how 
the  active  joints  act  combined  in  order  to  bring  the  passive  one  to  rest  Note  also  that  after  the 
passive  joint  is  braked,  the  active  ones  converge  smoothly  and  exponentiaUy  to  their  set- 
points.  The  animation  in  figure  10  shows  various  stages  of  the  movement  In  this  experiment 
also  the  fiill  dynamic  model  was  not  used  by  the  controllmi 

It  can  be  inferred  from  the  above  discussion  that  the  control  law  proposed  here  not  only 
controls  effectively  manipulators  with  passive  joints,  it  also  accounts  for  the  uncertainties  in 
the  dynamic  model.  Thus,  this  control  law  is  robust  miough  for  the  problem  in  hand. 

As  a  matter  of  comparison  with  previous  works  in  this  area,  we  also  ran  simulations  using 
the  control  law  proposed  in  [1],  but  without  using  the  pre-acceleration  phase  in  order  to 

obtain  comparable  results.  Namely,  we  repeated  experiments  #1  and  #2,  which  required  a  90^ 
excursion  of  both  joints,  with  and  without  the  use  of  the  full  dynamic  model,  respectively.  In 
order  to  have  a  fair  comparison,  we  adopted  the  same  saturation  levels  for  the  torque  at  the 
active  joint  The  results  are  shown  in  figures  11  and  12.  The  first  one  shows  that  when  the  full 
dynamic  model  is  used,  this  control  law  provides  a  performance  that  is  comparable  to  that 
provided  by  the  VSC.  However,  it  lacks  the  robustness  necessary  in  this  kind  of  system,  as 
we  can  see  in  figure  12.  The  passive  joint  cannot  reach  its  set-point  within  a  reasonable  time, 
and  the  active  joint  continues  to  bounce  trying  to  drive  the  passive  joint  to  rest 

If  we  compare  now  the  present  method  with  the  one  presented  in  [10],  we  can  affirm  that 
our  formulation  is  much  simpler,  and  that  the  braking  and  settling  times  are  much  smaller. 

As  for  implmnentation  purposes,  the  presmit  control  law  requires  the  computation  of  the 
inertia  matrix  of  the  manipulator,  M(q),  which  is  a  symmetric  matrix.  Thus,  our  scheme  is 
certainly  faster  in  computational  terms  than  the  computed  torque  controller,  which  requires 
the  computation  of  the  full  dynamic  model,  i.e.,  dm  computation  of  M(q)  and  of  b  (q,  4) . 
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6  Conclusion 

In  this  work,  the  authots  demonstrated  the  feaability  of  designing  a  robust  controller  for 
underactuated  manipulators.  The  control  of  such  systems  can  be  extended  to  the  control 
problem  of  fault-tolerant  robots,  space  robots  and  hypo'-redundant  robot  systems,  wl»ie  one 
or  more  joints  are  passive,  either  because  of  design  considerations  or  because  of  a  failure. 
Given  the  strong  dependency  of  the  control  system  on  the  dynamic  model,  uncertainties  in 
the  model  may  result  in  inaccuracy  and  loss  of  stability. 

The  scheme  proposed  here  consisted  of  a  variable  structure  controller,  used  along  with 
the  theory  of  sliding  surfaces.  This  control  method  makes  the  system’s  state  trajectory  slide 
over  a  pie-defined  sliding  surface  in  the  phase  plane,  which  in  turn  guarantees  tracking  and 
robusmess  properties.  The  main  point  in  this  work  was  the  demonstration  of  the  controller’s 
robustness  to  parameter  uncertainty.  Another  possible  approach  to  cope  with  the  uncertainties 
in  the  system  would  be  via  the  use  of  adaptive  control  techniques,  as  done  by  Gu  and  Xu  [6]. 

We  compared  the  proposed  control  law  with  the  one  presented  in  [1],  and  showed  that  our 
scheme  provides  the  system  with  a  much  greater  deal  of  robustness,  an  important 
characteristic  in  this  kind  of  highly  coupled  nonlinear  dynamic  system. 
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O  passivejciiu 

Hgure  1:  Three-link  manipulator  with  one  passive  joint. 


#  activejoint 
O  passivejoint 


Figure  2:  Two-link  manipulator  with  one  passive  joint 


ncrwtivMt 

Figure  3:  Determinant  of  Mp^  for  the  2-link  manipulator. 
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Hguie  6:  Response  of  the  2-link  manipulator.  Experiment  #2. 


XMOtH 

Figure  10:  Animation  of  the  3-link  manipulator.  Experiment  #S. 


Figure  11:  Response  of  the  2-link  manipulator.  Experiment  #1  with  control  law  from  [1]. 


